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ABSTRACT 


The Naval Postgraduate School UAV Laboratory developed a Small 
Unmanned Aerial Vehicle (SUAV) equipped with a Vision Based Target Tracking 
(VBTT) system as part of its Tacticai Network Topoiogy field experimentation 
program. The VBTT system includes a miniaturized gimbaied camera that allows 
autonomous target tracking whiie providing concurrent estimates of target motion 
inciuding its position, veiocity and heading. Using the current controi law, the 
speed of convergence and the range-holding performance have been found to 
deteriorate as target speed increases. The aim of this thesis is to elaborate on 
the existing controi iaw in order to achieve better performance. Employing a new 
and novel algorithm from the Lyapunov Stability Anaiysis, for the purpose of 
adjusting the feedback gain, is proposed in this thesis; to that end a control law 
with adjustable gain can be easily implemented based on UAV-Target kinematics 
to optimize UAV performance. The performance of the newly adjustable gain 
controi iaw is tested in both SIMULINK modei and Hardware-ln-the-Loop 
simulations to verify any improvement in performance over the constant gain 
controi iaw. Principal results offer improved SUAV target-tracking performance 
with no additional hardware costs. 
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I. INTRODUCTION 


A. BACKGROUND 

The proliferation of unmanned system technoiogy in military and 
homeiand security applications has accelerated in the past decade. The success 
of UAV and UGV use in every theatre of operations further cements the 
significance of an unmanned system technology application in modern warfare. 
During the 1991 Guif War, Unmanned Aerial Vehicles (UAV) were deployed as 
reconnaissance units which sought targets for navai guns. The War on Terror in 
Afghanistan and Iraq has seen the role of the UAV transition from a 
reconnaissance vehicie to an Unmanned Combat Air Vehicle where the UAV is 
armed with Hellfire missiie [1]. 

Unmanned Ground Vehicies (UGV), capable of combating against 
Improvised Expiosive Devices (lEDs), are also increasingly deployed in Iraq [2]. 
These remote-controlled ground vehicles have the ability to probe dubious 
objects and detonate any suspected lEDs. Unmanned aeriai vehicies and 
unmanned ground vehicles are, therefore, critical assets and effective force 
multipliers in today’s battiefield and future network-centric warfare. Due to the 
complementary capabilities of the UAV and UGV, collaboration of both 
unmanned systems expands the tacticai capabiiities of the integrated system in 
order to execute compiex missions. 

The UGV has a iimited Fieid-Of-View (FOV) and this leads to the UGV 

being less responsive to threats beyond its FOV; however with its aeriai 

superiority, the UAV has a superior FOV. By incorporating wireiess 

communication between the UAV and UGV, the UGV is abie to utilize the 

reconnaissance information provided by the UAV to speed up the UGV’s 

response to approaching targets. One key appiication of the integration of both 

unmanned piatforms is the ability to have unmanned force protection for ground 

troops operating in Iraq and Afghanistan [3]. Ongoing research at the Navai 
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Postgraduate School’s (NPS) Physics Department arms the UGV with shaped 
charges that can incapacitate soft skin vehicles and detonate suspected lEDs. 
Via aerial reconnaissance with onboard sensors, the UAV would be able to 
detect threats such as armored vehicles or anomalies such as suspected 
insurgent movements, minefields or suspected lEDs. The UAV would then 
dispatch the UGV to the area in order to neutralize the threat. 

B. PROBLEM STATEMENT 

Many large-scale tactical UAVs have evolved towards multi-role and multi¬ 
mission platforms. However due to the high acquisition cost, a limited number of 
UAVs are made available to support day-to-day troop operations in Iraq. Driven 
by technological advancements in miniature autopilots, networking and robotics, 
a low-cost Small UAV (SUAV) may be constructed using low cost Commercial- 
Off-the-Shelf (COTS) components to achieve the same capabilities. Therefore, 
the collaboration of SUAV and UGV offers unmanned force protection at a lower 
cost, yet provides an equally effective solution. 

The NPS UAV laboratory has developed a SUAV equipped with a COTS 
Vision Based Target Tracking (VBTT) system as part of the Tactical Network 
Topology field experiment program. The VBTT onboard the SUAV includes a 
miniaturized gimbaled camera that is capable of autonomous target tracking. The 
control concept of the SUAV is illustrated in Figure 1 below. The developed 
control guarantees that the SUAV is autonomously guided such that the target 
remains constantly in the FOV of the gimbaled camera [4]. This results in two 
coordinated motions: SUAV motion relative to target and motion of gimbaled 
camera relative to the target. Previous research has already addressed the issue 
of devising a coordinated camera and a UAV controlled law. The control 
algorithm for both gimbaled camera and UAV was developed, and preliminary 
results on the robustness of the control were obtained [5]. This thesis 
concentrates on further analysis of the stability bounds for the case of actively 
moving targets. 
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Figure 1. Illustration of Control Algorithm [From 4] 


C. SCOPE 


Previous thesis research showed that the control law stated below in 
equation (1) showed improved robustness and efficiency. However for constant 
feedback gain, the speed of convergence and the range holding performance 
deteriorate as vjv^ increases. Therefore, the objective of the research efforts in 

this thesis is to elaborate on the existing control law in order to improve the 
performance of the control law when vjv^ increases. 


i}/ = —cos 7- k^rj 
Pd 

y/^ = k^Ti + k^s 

77 = Navigation angle error 
s= Line-of-sight error 
Vg = SUAV ground speed 
k^,k 2 = Gain constants 


( 1 ) 


y/ = UAV turn rate in inertial frame 
y/f^ = Camera turn rate in UAV frame 
= Desired range 
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Since constant value for Gain parameters has performance limitations, 
this thesis aims to improve the performance of the control law by using an 
adjustable gain that factors UAV and target kinematics into the control law. The 
scope of work in this thesis includes testing the performance of adjustable gain 
over constant gain. 

D. THESIS OUTLINE 

In Chapter II, it is shown how the feedback control gain is derived from the 
Lyapunov Stability analysis that guarantees a bounded solution. It is also shown 
how adjustable gain for the UAV guidance varies with UAV and target 

kinematics, namely , v, and . The adjustable gain can be chosen to extend 
the region of attraction. Consequently the dynamics of as a function of , v, 
and are analyzed. 

Chapter III illustrates the Implementation of the control algorithm with 
adjustable gain in both the SIMULINK model of the SUAV and the Hardware-ln- 
the-Loop (HIL) simulation. The objective of running the SIMULINK model is to 
predict the performance of the newly developed control law while HIL simulation 
validates the results of SIMULINK model for physical SUAV. The performance of 
the modified control algorithm is then compared with the previous control 
algorithm and initial results of 5. An analysis of the results is presented in this 
chapter. 

Chapter IV presents the conclusion of the research efforts in this thesis 
and recommendations for future research. 
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II. DEVELOPMENT OF CONTROL LAW 


A. SUAV CONTROL SYSTEM MODEL 


Assuming that the autopilot module is capable of maintaining the UAV at 
level flight, the kinematics model for the UAV and target may be simplified into a 
two-dimensional problem. The two-dimensional kinematics model is shown in 
Figure 2 below. 



T] = navigation error 

£ “camera LOS Pan error 

A -LOS angle in inertia frame 

= LOS vector 

X = Nonnal to LOS vector 


= UAV heading in inertia frame 
“Target heading in inertia frame 
= Camera angle in UAV body frame 
= SUAV ground speed in inertia frame 
= Target ground speed in inertia frame 


Figure 2. Simplified 2-D UAV-target kinematics model [From 5] 

It is shown in [4] that the kinematics of the tracking problem is given by 
equation [2]. The angles ri and 8 denote the UAV guidance error and Gimbaled 
camera control errors; therefore, the control objective is to drive ri and 8 using the 
UAV turn rate y/ and y/^ as control inputs. 
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(2) 


Vcos,ri-V,cos,(\i/,-(\i/-ij)) . 

r] = —2 -^^ 


P 


e = 


^ cos 7-V, cos (^,-(^-7)) 
P 


¥-¥h 


p = -Vg sin 77 + V; sin(^^ -{y - 7)) 


By applying feedback control as described in equation (1) to the two-d 
kinematics model, the control system equations are given in equation (3)^ 

V = -VgPe cos {t]p, )/p, - k, fjp, + v,p cos {t]p, - If/^ )Ip, (3) 


Pe = sin(7/7^)- V, s,m{t]p, - xp^p^ 
e = v^p^ cos {f]p,)- k^e-v, cos {fjp, - xp^)p 

where xp^ represents the reiative heading xp-p^ with respect to the target. 

It is noted [4] that Equation (2) may be separated into two sub-systems. 
Sub-system I: 
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-VjA cos(77/7J//7^ - Km + v,/?cos(7/7^ - p^Ip, 

_A_ 


p\^ sin(7/7^ )- V, sin (7/7^ - p^ )p^ 


Subsystem II : 

s = v^p^ cos ifjp,)- k^s-v, cos (fjp^ - )p 

Sub-system I depicts the system dynamics that drive the UAV such that 
the ground speed vector of the UAV is perpendicular to the Line of Sight, i.e. 

f]=0 and yc^ = 0 . Thus ensuring the stability of sub-system I guarantees that the 
UAV orbits above the target, as illustrated in Figure 1. 


^ The derivation of the control system equations is given from equation (3) and equation (4) 
in Reference 5. 
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B. LYAPUNOV STABILITY ANALYSIS 


1. Stability Analysis for Stationary Target 

From equation (3), it is obvious that sub-system I is a highiy non-linear 
system. The Lyapunov function for the non-iinear system may be derived from 
the linearization of Sub-system I. Using Tayior Expansion, the iinearized modei 
is: 


-K 


X = 




(5) 


Solving for P from the algebraic Lyapunov Stabiiity criterion^, 


P = 


1 


k, 

Pd 



Pd_ 

2k,v] 


( 6 ) 


A candidate Lyapunov function [6] is given by T = x^Px. 
Re-expressing Subsystem I in terms of the linearized modei, 
x = AgX + lxf{x) where A/(x)=/(x)-A^x (7) 

By substituting equation (7) into t/and taking time derivative, 

V (x) = -x^x -I- 2 A/’^ (x)Px 
By substituting equation (3) into A/(x) yieids: 


A/(x) = 


,Pe (l - COS+ v,pcos{f]p, - xp^lp, 
v p^ sm{fjp^ )- V, sm{r]p^ -¥r)p^- — V 

Pd 


(8) 


2 Algebraic Lyapunov Stability Criterion is given by AjP -l- PA^ = -7 
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Define a compact set 0.^ = 1^:<c^;c = (P) for 0 < < 1 

Pd 


From matrix property, (P)||x||" < x^Px < 


(c^ 


X < I ^ 


IXJ 


1 (c^ 

yj. 


ri-c„v ri+c. 




The target is assumed to be stationary (v, = o), 


A/(x)= -2 . ( ^ 

v^p sin(/7)-^77 

Pd 


2v sin^ 


sin(7)-^7 




Using smaii angle approximation and equation (9), 




For small rj, |sin 7 - 7 |<L-L 

6 


I- II II ^ 2 2 

From X < — , rj <c 

ypd) 


Substituting equation (13) & (12) into (11) and after simplification, 
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Substituting equation (15) into v{x) 
y (x) < + 21 A/ (x)|| ||P|| ||x|| 

y(x)<- l-27j^^j||P|| ||x||" (16) 


From the Lyapunov Stability Criterion, y(x)< 0 only if ||p|| < 


2rv, 


2. Stability Anaiysis for Moving Target 


The stability of Subsystem I for a moving target can be analyzed in an 
approach similar to that of a stationary target. For most ground moving targets, it 
can be reasonably assumed that the target speed is bounded such that the least 
upper bound of target velocity is lower than v, . 


Re-arranging equation (8), 


¥(x) = 


cos 

v p^ 

Pd 


v,pcos{f]p, - y/,)lp. 


Substituting equation (15) into equation (18), 
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{v,pco^{f]p, - 


Pd 


+ {v,?,m{f]p,-y/^)p''^ 


Since 003 ( 7 /?^-< 1 and sm{j^p^-y/^^<\ 


(i)iHk4d 


I- L- /rt\ - ^ ^ 

From equation (9), p < - - 

y Pd ) 


/ ^^4 IIII ^ 


/iVi+p;p- 


[4 Wli/* + (' + 'ol 


Substituting equation (19) into v{x) 


v(x)< -x^x + 
v(x)< 


xl P u 


1 


tJ 


(19) 


Ul|- + 




X ^ 


^-Mi) 


Pd 

Pd 


The Lyapunov stability criteria requires v(x)< 0 for asymptotic stability. 


1 - 2rl|P|( ^]]\4 - 

Y Hd l^d 


>0 
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From stability analysis for a stationary target (Page 7), ||x|| < — 


2 v ( 

t,msLX \ 


^1 + 1 

(i+cji 

|p|| 

Pd - 

p 



( 20 ) 


Suppose the condition given by equation (20) is vaiid for aii 

K and ^ Subsystem 1 is 

^>0 

uitimateiy bounded for any x(o)3Q^ . Therefore defines the region of 
attraction (i?^) for subsystem I and is a measure for . The iarger the region 
of attraction , the larger is the space that wouid aiiow a SUAV to converge to 
the stabie soiution. 


C. DERIVING OPTIMAL GAIN FROM STABILITY CRITERION 


Two new parameters and af© introduced below in equation (21) and 
equation (22) to determine the appropriate values of gain \ for both stationary 
target and moving target cases. From the previous stability analysis, it is evident 
that the regions where €^>0 and €^>0 are the regions of stabiiity. Figure 3 and 
Figure 4 iilustrate the dependency of on and for known UAV-Target 
kinematics 


2rv^ 


2v,,,„ax { 


h 

[i+cji 

|p|| 

Pd-2rvg 

p 



( 21 ) 


( 22 ) 
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Figure 3. Stationary Target case, gj = for = 10, p^ = 100 



Figure 4. Stationary Target contour, ej = f{k^,Cp) for = 10 ,p, = 100 

One observation from Figure 3 is the intersection of surface with the 
plane gj »0, within the stable region (gj >0) yields an optimal choice of k^ that 
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maximizes c^, i.e., maximizes the region of attractions?^. A second observation 
from Figure 4 suggests that the optimal choice of remains unchanged when 
the surface intersects with any plane = constant. From both observations, it 
is postulated that an optimal exists from the Lyapunov stability analysis. 
Successive runs of with varying speeds of UAV further confirm the existence 
of optimal k^. 

In many practical military missions, foe targets more consistently keep 
maneuvering or evading than remaining stationary. An optimal feedback gain k^ 
is defined by analyzing the numerical results derived from the Lyapunov Stability 
Analysis as applied to the moving target scenario. The optimality of the feedback 
gain is defined by the extension . Figure 5 and Figure 6 below illustrate the 
dependency of on k^ and based on equation (22) for known UAV-Target 
kinematics. The surface figures are obtained for the following parameters: 
Vg = 10, p^ = 100 and = 10. 


Cr 

Figure 5 . Moving Target case, = f{k^,Cp) for = 10, = 10 ,/ 7 , = 100 
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Figure 6. Moving Target contour, e.^ = f{k^,Cp) for = 10 ,v^ = 10 ,yc^ = 100 

Similar to the stationary target case, Figure 5 and Figure 6 suggest that 
optimal may be defined from the Lyapunov Stability function for the moving 
target scenario. From Figure 5 , it is observed that is also a critical parameter. 
The optimal is obtained only when a suitably defined plane intersects with 
the ^2 surface. Successive runs of with varying UAV speed and target speed 
in Appendix II likewise reinforced the existence of optimal k^. Hence from the 
Lyapunov Stability Analysis for the control law implemented, it is deduced that an 
optimal exists that maximizes the performance of the control law by 
extending . The concept of Region of Attraction is illustrated in Figure 7 on 
the following page. From the kinematics, it is shown earlier that the states of the 
system are given by range error, navigation error and line-of-sight error. Once 
the phase trajectory enters/?^, the state of the dynamic system automatically 
converges to a stable solution. From a system-stability viewpoint, larger is 
desired so that the stability of the system is insensitive to disturbances. 
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It is evident that the stable solution has a smaller error magnitude for the 
smaller/?^. The larger \UeR^, the higher the likelihood that the stabilized solution 
will be displaced much further from the origin. Figure 8 below depicts the 
changes in the region of attraction with increasing A:j. The increase in drives 
the reduction in the size of . 



Figure 8. Steady-State Trajectory showing Region of Attraction 
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The desired phase trajectory first selects a smaller k^ so that the phase 
trajectory begins converging to a stabilized solution in the shortest time. Once the 
phase trajectory begins converging to a stabilized solution, it is desirable to 
Increase to drive the error of the stabilized solution to a minimum. Therefore 
the optimal as defined by the Lyapunov Stability Analysis seeks the optimal 
tradeoff between the steady state error and speed at which phase trajectory 
arrives at . The dependency of optimal upon , and is studied in 

greater detail in the next section so that adjusted gain may be implemented In the 
control law for the SUAV. 

D. DEPENDENCE OF OPTIMAL GAIN ON TARGET SPEED v, 

Deriving the analytical expression for optimal k^ from equation (22) is 
mathematically complicated. To circumvent the mathematical challenges, the 
optimal k^ is established by computing the optimal gain as target speed varies. 
The SUAV speed is constant at 10 m/s at a desired range of 50m. Figure 9 
shows a variation of surface as target speed v, increases from 1 m/s to 10 
m/s. 



G 


Figure 9. Changes in Surface as increases 
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From Figure 9, it is observed that increments in target speed shift the ej 
surface toward higher vaiues of ^2 ■ A fixed plane of e.^ is thus not practicable 
because the intersection of the fixed piane with surface does not guarantee 
the required contour. However by defining the intersecting piane e^=v^, desired 

contours to compute optimal \ can be obtained for each . The effect of 
increasing target speed on the shape of surface is more obvious from the 
contour plot instead. The series of contours is depicted in Figure 10 below. 



Figure 10. Contours for intersection of e.^ plane with e.^ surface 

From the contour lines, the optimai at different are computed, and 

the dependency of optimai on is plotted in Figure 11 beiow. The results 
obtained show that optimal k^ (where is maximum) is independent of target 

veiocity, i.e. opr/ma/only. The independence relationship between 

optimai k^ and remains valid for different values of SUAV speed and desired 
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distance. Since the optimai for each target speed is obtained via different 
vaiues for the piane, a comparison of for each optimal does not draw 
any meaningful conclusion. 

Optimal versus Target Speed 

0.61-^---,---,-----,-. 

0.55- 

0.5- 

0.45 

0.4 

g 0.95 - 

S. 

O 0.3 - 

025 

02 - 

0.15- 

0.1 I I . 1 I i 1 1 1 

1 23458789 10 

Figure 11. Optimai k^ versus Target Speed 

The dynamics of subsystem I drive the UAV to orbit around the target at a 
desired distance. From the controi iaw impiemented, the vaiue of gain k^ drives 
the heading of the UAV to achieve its desired orbit. Since the turn rate of the 
UAV is iimited by its orbital angular momentum, the optimal gain k^ depends on 
and p, only. 

E. DEPENDENCE OF OPTIMAL GAIN ON 

A similar approach is undertaken to investigate the dependence of optimai 
gain on p^. To demonstrate the changes in surface as increases from 
100 m to 500m, the SUAV speed is maintained at 10 m/s and the target speed is 
kept constant at 5 m/s. The surfaces in Figure 12 below indicate that the effect 
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of increasing shifts the ej surfaces closed towards the axis (iower 
vaiues for the same gain ). The absence of vertical shifts for the surfaces in 
Figure 12 allows a fixed ievel of ^2 plane to intersect with changing ^2 surfaces. 
The contour piot in Figure 13 below depicts the shape change in surface due 
top,. 


□ocrsasirH RMO. 



Figure 12. Changes in surfaces as p, decreases 



Figure 13. Contours for intersection of plane with surface 
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The contour plot in Figure 13 suggests that optimal gain decreases as 
increases. From kinematics, a larger value of is expected to reduce the turn 
rate expected of SUAV. The SUAV thus requires a smaller rate of change in 
bearing, and this leads to a smaller value for optimal gain. A similar argument 
can also be extended for the relationship between the optimal gain and varying 

Vg for a constant desired range/?^. The larger the SUAV speed, the larger the 

turn rate expected from the SUAV in order to maintain the desired range. This 
SUAV thus requires a faster rate of bearing change, and this leads to a larger 
value for optimal gain. 

For implementation of the proposed adjustable gain control law, it is 
assumed that the SUAV has a constant operating speed of 10 m/s to 50 m/s, and 
the desired tactical range is from 100m to 500m. The optimal gain for the 
assumed range of operating conditions is tabulated In Table 1 below, and Figure 
14 illustrates the dependence of the optimal gain on SUAV speed and desired 
range to target. Flenceforth for an SUAV operating within the assumed tactical 
operating conditions, an adjusted gain control law can be implemented in 
SIMULINK model and MIL simulations. In the following chapter, the performance 
of the adjustable gain control law is evaluated In both Simulink model testing and 
hardware simulation testing. 


k opt 

1 

Pd 

V 

8 

100m 

150m 

200m 

250m 

300m 

350m 

400m 

450m 

500m 

10 m/s 

0.165 

0.115 

0.09 

0.075 

0.065 

0.055 

0.045 

0.035 

0.035 

20 m/s 

0.32 

0.215 

0.16 

0.13 

0.1050 

0.09 

0.08 

0.075 

0.065 

30 m/s 

0.42 

0.285 

0.21 

0.17 

0.14 

0.12 

0.105 

0.095 

0.085 

40 m/s 

0.55 

0.38 

0.285 

0.23 

0.19 

0.165 

0.145 

0.125 

0.115 

50 m/s 

0.73 

0.51 

0.38 

0.3050 

0.255 

0.215 

0.190 

0.17 

0.155 


Table 1. Optimal Gain for Tactical Operating Condition assumed 
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Figure 14. Dependence of the optimal gain on and 
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III. ADJUSTABLE GAIN IMPLEMENTATION 


A. MODIFICATION OF SIMULINK DIAGRAM FOR ADJUSTED GAIN 


With the implementation of an adjustable gain in the control law in 
equation ( 1 ), the modified control law is given by: 


¥ = 


—C0S7- 
Pd 


^l,opt 


1 


(23) 


¥h = ^i,opt7+ hs 

Where K,,, = f (vp,) 


The control system architecture as depicted in Figure 15 below 
implements the control law given by equation (23). The adjustable gain control 
law is implemented within the VB Control block. It consists of an autopilot and a 
gimbaled camera driven by the control inputs \j/ and y/^. The onboard camera 
provides real-time video to the imagery target-tracking software. This software 
computes the tracking error s when the target is engaged. The onboard GPS 
and inertial navigation systems measure the navigation error 7 for the SUAV. 
The Control System Architecture is modeled in SIMULINK to predict the target¬ 
tracking performance of the SUAV with the amended control law. 


¥ 

n 



Figure 15. 


Control System Architecture 
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B. SIMULATION RESULTS FROM SIMULINK MODEL 


The performance and the system response to the newly developed 
adjustable gain control law are predicted for the following target scenarios: (1) 
stationary target scenario, (2) non-maneuvering moving target scenario, and (3) 
maneuvering target scenario. Since the system response of most control 
systems can be modeled either as a first order or a second order system [7], two 
measures of performance (MOP-1 and MOP-2) are defined as follows: 

• MOP-1 is defined as the percentage of maximum steady-state 
range deviation as compared to the desired range. MOP-1 thus 
measures the SUAV range-holding capability after converging to 
the steady-state flight path. This is similar to the measurement of 
performance used in [5]. 

• MOP-2 is defined as the convergence speed, computed by the ratio 
of desired range to convergence time. Unlike in [5], convergence 
time is defined such that the response is contained within MOP-1. 
This allows MOP-2 to be a well-defined parameter even if the 
response is similar to that of an over-damped second-order system. 

1. Simulation Results for Stationary Target 

The adjustable gain control law is developed from the Lyapunov Stability 
Analysis for a moving target. The analysis of parameter in Chapter II shows 
that optimal gain is independent of target speed. It is thus deduced that the 
optimal gain in Table 1 remains valid even when the target is stationary. For the 
stationary target scenario, simulations are conducted to achieve the following 
objectives: 
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• To investigate the system response of the adjustable gain in control 
law 

• To investigate the performance obtained by utilizing the adjustable 
gain control law over the previous control law 

The initial conditions for this simulation run are: (1) SUAV velocity = 28 
m/s, (2) SUAV location = [0, -1000, 300], (3) Target location = [0, 0, 0], (4) 
^2 = 0.25 and (5) = 300 . The results are illustrated in Figure 16 on the 

following page. 


(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 



(b) Range Convergence Performance, = 300 m (286) 
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Range Convergence 



(c) Navigation bearing error Convergence Performance 


Navigation bearing angie convergence performance 



(d) Adjustable Gain versus Time 
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Adaptive Gain versus Time 



Figure 16. SUAV Performance in Tracking Stationary Target 

The performance of the adjustable gain control law for this simuiation run 
is described as foiiows: 

a) From Figure 16b, the SUAV converges to a steady-state range of 
284m from the stationary target and the steady-state range error is 
16m. MOP-1 is evaiuated to be 5.33%. 

b) The 2% settling time for the SUAV range is measured to be 122 
seconds from Figure 16b. Comparing the response of Figure 16b 
to Figure 14c and Figure 16d, all three figures have identical values 
for 2% settling time. MOP-2 is thus evaluated to be 4.098 m/s. 

c) From Figure 16c and 16d, it is evident that the navigation bearing 
error and gain parameters begin to converge oniy after 32 seconds. 
It is deduced that the SUAV take 32 seconds to arrive at the region 
of attraction and the convergence time within to the stable 

solution is approximately 90 seconds. 
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The aim of the first simulation run is to investigate the improvement in 
performance. The previous simulation is repeated with the same set of initial 
conditions with a different constant gain ranging from fcj = 0.1 to k^ = QA. The 
improvement in performance is assessed by the MOP-1 and MOP-2 comparison 
obtained for each case. The performance obtained for each case is appended in 
Appendix II and summarized in Table 2 below. 


Gain 

MOP-1 

MOP-2 

0.1 

6.67% 

3.62 m/s 

0.2 

5.68% 

2.18 m/s 

0.3 

19.3% 

1.72 m/s 

0.4 

32.0% 

1.09 m/s 

Adjustable 

5.33% 

4.10 m/s 


Table 2. Performance Comparison between Adjustable Gain versus Constant Gain 


A comparison of MOP-1 suggests that there is a constant gain of 0.1 to 
0.3 that reduces the steady-state error to a minimum. However as the gain 
increases from 0.1 to 0.3, a comparison of MOP-2 shows that the speed of 
convergence decreases. Thus from the performance of the adjustable gain 
control law, it is concluded that the implementation of an adjustable gain seeks 
the optimal balance between MOP-1 and MOP-2, i.e. seeking the lowest steady- 
state range error while optimizing the speed of convergence. 

2. Simulation Results for Non-Maneuvering Target 

The objectives in the series of simulations conducted for a non¬ 
maneuvering target are similar to that of the stationary target. The first objective 
is to investigate the performance of the adjustable control law when the target is 
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moving in a constant velocity. For the stationary target scenario, the adjustable 
gain gives optimal performance by the optimal tradeoff between MOP-1 and 
MOP-2. The second objective is, therefore, to investigate whether optimized 
performance of an adjustable control law remains valid for the moving target 
scenario. The parameters for the series of simulations conducted are identical to 
the stationary target scenario, except that the target is now moving in an easterly 
direction with a speed of 5 m/s. The initial conditions for this simulation run are: 
(1) SUAV velocity = 28 m/s, (2) SUAV location = [0, -1000, 300], (3) Target 
location = [0, 0, 0], (4) k 2 = 0.25 and (5) > 0 ^ = 300. (6) Target velocity = 5 m/s. 
The results obtained are illustrated In Figure 17 on the following page. 


(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 



(b) Range Convergence Performance, = 300 m 
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Range Convergence Performance 



(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Adjustable Gain versus Time 
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Adaptive Gain versus Time 



Figure 17. SUAV Performance in Tracking Non-maneuvering Targets 

The observations of the simulated SUAV performance for tracking a non¬ 
maneuvering target are summarized as follows: 

a) Figure 17b indicates that the SUAV range does not converge to a 
fixed value. Instead the SUAV range continuously oscillates within 
bounds as suggested by the results of the Lyapunov stability 
analysis. 

It is observed that the steady state response of range oscillates 
between 334.5 m and 249.5 m, and the mean value is 292 m. The 
previous performance measure for MOP-1 is an inadequate 
measure for range convergence. For a moving target, an alternative 
performance measure for range convergence is devised, MOP-3. 
MOP-3 computes the percentage error between the desired range 
and the mean value for the steady-state function; thus, MOP-3 is 
calculated to be 2.67%. 
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b) Likewise the convergence time defined previously is not applicable 
in the case of a non-maneuvering target. Instead of utilizing the 2% 
settiing time as a measure, the convergence time is re-defined as 
the time taken for a response to reach steady state function. From 
Figure 17b the convergence time is 140 seconds. MOP-2 is thus 
evaiuated to be 3.57 m/s. 

c) From Figure 17c and Figure 17d, the SUAV takes 31.2 seconds to 
be within the region of attraction (as shown in Figure 15). 
Likewise, the convergence time within is dependent upon the 
initiai position of the SUAV from the target. It is also observed that 
the steady state response for feedback gain is an oscillatory 
waveform instead of a fixed vaiue. 

d) Since the steady state response for range error and navigation 
osciiiates within bounds, the region of attraction can be estimated 
from the magnitude of the bounds, as shown in Figure 17c and 
Figure 17d. 

In the second series of simulation runs, the aim is to investigate the 
improvement in performance of the adjustable gain control law over the constant 
gain control law for non-maneuvering targets. The initiai conditions for this 
simulation run are: (1) SUAV veiocity = 28 m/s, (2) SUAV iocation = [0, -1000, 
300], (3) Target location = [0, 0, 0], (4) k^ = Q25 and (5) = 300. (6) Target 

veiocity = 5 m/s. The previous simuiation is repeated with different constant gains 
ranging from = 0.05 to k^ = 0.4. The performance obtained for each case is 
appended in Appendix III and summarized in Tabie 3 beiow. 
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Gain 

MOP-3 

MOP-2 

0.05 

9.00% 

1.97 m/s 

0.1 

4.50% 

3.03 m/s 

0.2 

6.27% 

2.66 m/s 

0.3 

20.32% 

2.18 m/s 

0.4 

32.92% 

1.37 m/s 

Adjustable 

2.67% 

3.57 m/s 


Table 3. Performance comparison for Non-maneuvering Target at 5m/s 

A comparison of MOP-3 in Table 3 suggests gain A:; = 0.1, reducing the 
steady-state error to a minimum. The same value of also increases the 
convergence speed to maximum and gain /:i = 0.1 appears to be the optimum 
gain. However, it is evident that the adjusted gain shows a much improved 
performance over the constant gain control law. Therefore, optimized 
performance for the adjustable gain control law remains valid for a constant 
speed non-maneuvering target scenario. 

Previously in 5, it has been demonstrated that for the constant gain control 
law, SUAV target-tracking performance degrades, i.e. an increase in range error 
and a decrease in convergence speed is created. This motivates the need for a 
more rigorous analysis to determine the sensitivity of an adjustable gain control 
to target speed. The simulation is repeated with target speeds varying from 5 m/s 
to 20 m/s; the performance for each target speed is appended in Appendix III. 
The initial conditions are: (1) SUAV velocity = 28 m/s, (2) SUAV location = [0, - 
1000, 300], (3) Target location = [0, 0, 0], (4) k^=Q>.25 and (5) yO^ = 300. The 
sensitivity of the adjustable gain control law to target speed is summarized in 
Table 4. 
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Target Speed 

MOP-3 

MOP-2 

20 m/s 

18.80% 

5.00 m/s 

15 m/s 

9.8% 

5.35 m/s 

10 m/s 

3.00% 

3.45 m/s 

5 m/s 

2.67% 

3.57 m/s 


Table 4. Performance comparison for varying Target Speed 


As observed from Table 4, an increase in target speed leads to 
degradation in the range holding for the adjusted gain control law. The closer the 
target speed approaches the SUAV speed, the more severe the degradation in 
range holding becomes. This may be noted by the comparison of MOP-3. 
Intuitively the sudden increase in MOP-2 for target speed at 15 m/s is due to the 
larger range error. The larger the range error, the larger the SUAV orbit radius is 
expected to become, resulting in a faster convergence speed. 

The conclusion derived from the series of simulations conducted for non¬ 
maneuvering targets include: 

a) The adjustable gain control law improves performance as 
compared to the constant gain control law. The use of the 
adjustable gain in the control law optimizes range convergence 
performance and convergence speed. 

b) Range-holding performance degrades with increased target speed. 
As target speed approaches the SUAV speed, the more severe the 
degradation in range holding performance. However, convergence 
speed improves with target speed increase. 
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3. 


Simulation Result for Maneuvering Target 


The initial conditions for this simulation run are: (1) SUAV velocity = 28 
m/s, (2) SUAV location = [0, -1000, 300], (3) Target location = [0, 0, 0], (4) 
= 0.25 and (5) = 300. (6) Target velocity = 10 m/s. 


(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 
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(b) Range Convergence Performance, = 300 m 
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Range Convergence Performance 



(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Adjustable Gain versus Time 
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Adaptive Gain versus Time 



Figure 18. SUAV Performance in Tracking Maneuvering Target 

In Figure 18b, the measure of performance for the maneuvering targets 
are given by (1) MOP-3 = 24.28 % and ( 2 ) MOP -2 = 3.81 m/s. In comparing the 
results obtained in Table 4, it is evident that when a target changes its course of 
direction, the range hoiding capability of the SUAV deteriorates significantiy. The 
navigation error 7 is much iarger compared to that of a non-maneuvering target, 
and speed of convergence is reduced significantly. Flowever the SUAV continues 
to track the target, as shown by the SUAV trajectory in Figure 18a, with a larger 
region of attraction. Flence it is concluded that the adjustable gain control law as 
proposed in equation (23) is capabie of tracking a maneuvering target. 

C. HARDWARE-IN-LOOP SIMULATION 

The intention of FIIL simuiation is to validate the performance improvement 
conciuded previously from the SIMULINK model. The simulated SUAV model 
has demonstrated improved performance by the adjustabie gain control law in 
equation (23) over the previous control law. In practical implementation of an 
SUAV coiiaborating with the UGV, the SUAV actuai response differs from the 
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SIMULINK model of the SUAV. Hardware-ln-The-Loop (HIL) simulation has been 
carried out to ensure the robustness of the modified control law. The SUAV used 
for the HIL simulation is the Senior Telemaster SUAV shown in Figure 19 below. 
The HIL setup and the results obtained are described in a later part of this 
section. 



Figure 19. Senior Telemaster SUAV [From 4] 

1. Hardware-In-Loop Setup 

Cloud Cap Technology has developed an integrated avionics system 
control (Piccolo) for small-unmanned aircraft that allow HIL testing of SUAV 
performance. Piccolo consists mainly of four parts: an avionics control system 
onboard SUAV, a Ground Control Station (GCS), a PC for manned operations, 
and manual flight control via a modified Futaba radio controller. The HIL 
hardware setup is identical to that performed in 5. The HIL setup in the SUAV is 
depicted in Figure 20 below: 
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Figure 20. Schematic of HIL Setup [From 5] 


The Piccolo system has severai control loops. The slower outer loop 
computes the desired turn rate reference command for circuiar guidance and 
sends the command turn rate to the faster inner loop. The faster inner loop then 
controls the actuators so as to follow the reference commands and therefore 
maintain stabie dynamics of the aircraft. In the FIIL setup and simulation 
environment, the autopiiot is connected to the second computer via the USB- 
CAN data exchange cable. The simulator, which runs in the second computer, 
tests the aircraft control laws in a software environment with the servo and 
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sensor data which is received from the CAN bus. Since the simulator 
communicates with the avionics in reai time, the second computer is isolated for 
simulator software only. The GCS is of simiiar hardware configuration as the 
avionics system onboard the SUAV. The GCS manages the communication iink 
to the avionics system to interface with the autopiiot in the loop console. It also 
provides a command and control stream to the operator’s PC via a standard 
ninepin seriai cable. The third computer runs the Fiight Gear application that 
provides visualization of the effect of the controi law on flight performance and 
stabiiity of the aircraft. More detailed information regarding the MIL setup may be 
obtained from Ref 5, Ref 8, Ref 9 and Ref 10. 

By employing an XPC Target within the SIMULINK Reai-Time Workshop 
(RTW) environment, MIL simulation may be executed by the PC-104 board 
onboard the SUAV. The simuiation modei in SIMULINK is compiled on the Host 
PC into ‘C’ code that runs on the Target PC. The real-time capabiiity of the 
system executes the code at a regular interval for optimal control. From the 
previous SIMULINK model, the AP controller block and the 6-DOF aircraft modei 
biock are replaced with the actuai Piccoio AP controiier hardware. The simulator 
software provides the sensor input that is required to compute the simulated flight 
parameters of the aircraft. The SIMULINK model schematic for the XPC Target 
modei is identicai to that in Tay’s work except for the gain input to the control law. 
The SIMULINK model schematic for the HIL simulation is depicted in Figure 21 
on the following page. The procedure for running the XPC HIL simulation is 
documented in Appendix V. 
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Figure 21. XPC Target Model Schematic 
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2 . 


HIL Simulation Results 


The objectives in the series of simuiations that were conducted for a 
stationary target are identical to those performed for the SIMULINK modei of the 
SUAV. The first objective is to investigate if impiementation of the adjustable gain 
controi law in physicai hardware offers improved performance over the constant 
gain control law. The first series of simuiations repeats the HIL simulation with a 
different constant gain, ranging from = 0.05 to = 0.4 for the adjustable gain 
case. The second objective is to investigate the sensitivity of the adjustabie gain 
controi law to target speed. In the second series of HIL simulations, target 
veiocity varies from 5 m/s to 20 m/s. The initial conditions for this simuiation run 
are: (1) SUAV veiocity = 28 m/s, (2) SUAV location = [0, -1000, 500], (3) Target 
location = [0, 0, 0], (4) k^ = 0.25 and (5) = 300. Figure 22 below shows the 

HIL simulation resuit obtained for stationary target scenario. 



(a) SUAV & Target Trajectory 
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(b) Range Convergence Performance, P, = 300 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 
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(d) Adjustable Gain versus Time 



Figure 22. SUAV HIL Performance in Tracking Stationary Target 

Uniike the SIMULINK modei, the trajectory of an SUAV does not converge 
to a fixed range from the target. However the response of the HIL simulation is 
simiiar to that obtained for maneuvering targets where steady-state responses of 
the SUAV are within bounds. Through comparisons of Figure 20b to Figure 14b, 
it is evident that the HIL simulation introduces more disturbances to the steady- 
state response. This is because the SIMULINK model in simuiation does not 
reflect the actual hardware response. Instead the SIMULINK model is an 
approximation to the behavior of the actuai hardware. A similar response to the 
adjustable gain control law is expected. As such, MOP-3 is a more suitable 
performance measure than the MOP-1 is. Simiiarly MOP-2 defined for moving 
targets is used as the performance measure for speed of convergence. MOP-3 is 
measured to be - 8.01 m, and MOP-2 is measured to be 3.71 m/s. The 
performance of constant gain controi law in HIL simulations are appended in 
Appendix IV and summarized in Tabie 5 on the following page. 
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Gain 

MOP-3 

MOP-2 

0.05 

4.68% 

1.44 m/s 

0.1 

2.95% 

3.53 m/s 

0.2 

4.62% 

3.13 m/s 

0.3 

11.87% 

2.56 m/s 

0.4 

16.12% 

2.41 m/s 

Adjustable 

2.67% 

3.71 m/s 


Table 5. HIL Performance comparison for Stationary Target 

Although the HIL simulation outcome varies significantly from the 
SIMULINK model, the flight characteristics and control law behavior are identical 
to that of the SIMULINK model. Similar to the SIMULINK, Table 5 suggests that 
at gain =0.1 the average steady state range error is at its minimum. For the 
same value of convergence speed is at its maximum, and gain ^j = 0.1 
appears to be the optimum gain for the constant gain control law. However Table 
5 also demonstrates that the adjustable gain control law has improved 
performance over the constant gain control law. Hence from the first series of HIL 
simulations, optimal performance for the adjustable gain control law is validated 
in an HIL Simulation environment. 


Target Speed 

MOP-3 

MOP-2 

20 m/s 

48.67% 

6.96 m/s 

15 m/s 

22 .86% 

6.13 m/s 

10 m/s 

8.63% 

4.23 m/s 

5 m/s 

1.36% 

6.38 m/s 


Table 6. HIL Performance comparison for Non-Maneuvering Target Speed 
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Table 6 validates the previous SIMULINK hypothesis that the increase in 
target speed ieads to degradation in the range holding for the adjustable gain 
controi law. The closer the target speed approaches the SUAV speed, the more 
severe the degradation in range hoiding becomes. This may be noted by the 
comparison of the MOP-3. Similar to the results for the SIMULINK model, the 
larger SUAV orbit radius is expected for iarger range error and thus faster 
convergence speeds. Since the results from the SIMULINK model simulation 
and the XPC Target simulation are identical, the improved performance for 
adjustabie gain controi law has been verified. 
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IV. CONCLUSION AND RECOMMENDATIONS 


In comparison with the constant gain controi law as defined by equation 
(1), the newiy modified controi law selects an optimal gain by taking the desired 
range and SUAV speed. The condition for optimal gain is derived from the 
Lyapunov Stabiiity anaiysis, based on the kinematics of target tracking, thus 
ensuring the robustness of the control system. The performance improvement 
provided by the adjustabie gain control law developed in equation (23) seeks the 
optimai tradeoff between speed of convergence and range holding capabiiity. 

The resuits obtained from the impiementation of the adjustable gain 
controi iaw in both software simuiation and Hardware-In-Loop simulations 
showed identical improvement in performance over the previous control law. 

Recommendations for future research: 

a) Since the modified controi law offers improved performance without 
incurring hardware costs, it is recommended that actuai fiight triais 
should be conducted to test the robustness of performance gain 
where the SUAV is subjected to unwanted aerodynamic 
disturbances in a practical environment. 

b) It is aiso recommended that future work shouid seek further 
refinement of the controi iaw, particulariy the dependence on 
continuous varying target speed and direction. 


47 



THIS PAGE INTENTIONALLY LEFT BLANK 


48 



LIST OF REFERENCES 


[1] J.C.Wong et ai, DSTA Horizon 2005: “Unmanned Aerial vehicle: 
Development Trends & Technology Forecast,” Internet 21 Aug 2007, 
Available at http://www.dsta.aov.sq/index.php/DSTA-2005-Chapter-2/ . 

[2] United States President’s Office of Management and Budget, “Budget 
of United States Government FY 2007”; Internet 5 Sep 2007, Available 
at http://www.whitehouse.qov/omb/budqet/fv2007/defense.html . 

[3] David M. Carroll, Jerry L. Harbour, Scott G. Bauer, David J. Bruemmer 
eta\., “Enabling Technologies for Unmanned Protection Systems,” 

SPIE Proc 5804: Unmanned Ground Vehicle Technology, 29-31 Mar 

2005. 

[4] Dobrokhodov V.N, Kaminer I, Jones K.D, Ghabcheloo R, “Vision-based 
tracking and motion estimation for moving targets using small UAVs,” 
American Control Conference 14-16 June 2006. 

[5] B.Tay,” Development and implementation of New Control Law for 
Vision Based Target Tracking system onboard small unmanned aerial 
vehicles,” Master’s Thesis, Naval Postgraduate School, Monterey CA, 

2006. 

[6] H.K. Khalil, “Nonlinear systems,” Prentice Hall, 3'^'^ edition 2001. 

[7] Ogata Katsuhiko, “Modern Control Engineering,” Fourth edition. New 
Jersey. Prentice Hall, 2002. 

[8] Bill Vagilienti, and Ross Hoag, “Piccolo System User Guide.” Cloud Cap 
Technologies, 2004, from http://www.cloudcaptech.com (10 Nov 2007). 

[9] “Introduction to PC 104 Setup, Building XPC Model for Target PC,” from 
http://lims.mech.northwestern.edu/students/stephens/me333/main.html 

(11 Nov 2007). 

[10] “PC 104 Embedded System FAQ,” 
http://www.controlled.com/pc104faq/ (14 Nov 2007). 


49 







THIS PAGE INTENTIONALLY LEFT BLANK 


50 



APPENDIX I 



Figure 23. SIMULINK MODEL 
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Figure 24. XPC HIL MODEL 
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APPENDIX II: STATIONARY TARGET TRACKING 


Stationary Target Tracking: Case 2: = 0.1 


(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 



(b) Range Convergence Performance, = 300 m, (280m 138sec) 


Range Convergence 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



Figure 25. SUAV Target Tracking Performance with Gain = 0.1 

Stationary Target Tracking Case 3: = 0.2 

(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 
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(b) Range Convergence Performance, = 300 m (229s, 317m) 


Range Convergence 



(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence pertormance 



Figure 26. SUAV Target Tracking Performance with Gain = 0.2 
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Stationary Target Tracking Case 4: = 0.3 


(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 



(b) Range Convergence Performance, = 300 m (291s, 358m) 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



Figure 27. SUAV Target Tracking Performance with Gain = 0.3 

Stationary Target Tracking Case 5: = 0.4 

(a) SUAV & Target Trajectory (460s, 396m) 


SUAV & Target Trajectory 
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(b) Range Convergence Performance, = 300 m 


Range Convergence Performance 



(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 
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Figure 28. SUAV Target Tracking Performance with Gain = 0.4 
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APPENDIX III: NON-MANEUVERING TARGET TRACKING 


Performance Benchmark Case ^ \ k^ = 0.4 


(a) SUAV & Target Trajectory 


SUAV & Targe! Trajectory 



(b) Range Convergence Performance, = 300 m, (280m 138sec) 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation boaring angle con verger ce performance 
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Figure 29. Non-Maneuvering Target Tracking Performance with Gain k^ = 0.4 


Performance Benchmark Case 2: = 0.3 


(a) SUAV & Target Trajectory 


SUAV St Target Trajectory 
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(b) Range Convergence Performance, = 300 m 



(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 
30 r 
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Figure 30. Non-Maneuvering Target Tracking Performance with Gain = 0.3 
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Performance Benchmark Case 3: = 0.2 


(a) SUAV & Target Trajectory 



(b) Range Convergence Performance, P, = 300 


Range Convergence Performance 



Figure 31. Non-Maneuvering Target Tracking Performance with Gain = 0.2 


62 




















Performance Benchmark Case 4: A:; = 0.1 


(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 



(b) Range Convergence Performance, P, = 300 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angie convergence performance 



Figure 32. Non-Maneuvering Target Tracking Performance with Gain A:j = 0.1 

Performance Benchmark Case 4: = 0.05 

(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 
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(b) Range Convergence Performance, P, = 300 


Range Convergence Perlormance 



(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



Figure 33. Non-Maneuvering Target Tracking Performance with Gain \ = 0.05 
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Target Speed Sensitivity Case 1 : v, = 10 m/s 


(a) SUAV & Target Trajectory 


SUAV & TargGt Trajectory 
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(b) Range Convergence Performance, P, = 300 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Adjustable Gain versus Time 


Adaptive Gain versus Time 



Figure 34. Adjustable Gain Control Law Performance v, = 10 m/s 
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Target Speed Sensitivity Case 2: v, = 15 m/s 


(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 



(b) Range Convergence Performance, Pd = 300 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Adjustable Gain versus Time 


Adaptive Gain versus Time 



Figure 35. Adjustable Gain Control Law Performance v, = 10 m/s 
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Target Speed Sensitivity Case 2: v, = 20 m/s 


(a) SUAV & Target Trajectory 


SUAV & Target Trajectory 



(b) Range Convergence Performance, = 300(18.80%) 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Adjustable Gain versus Time 


Adaptive Gain versus Time 



Figure 36. Adjustable Gain Control Law Performance v, = 20 m/s 
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APPENDIX IV MIL SIMULATION RESULTS 


Stationary Target Case 1: A:j = 0.1 


(a) SUAV & Target Trajectory 


HIL: SUAV & Target Trajectory 



(b) Range Convergence Performance, P, = 300 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angie convergence performance 



Figure 37. Constant Gain Control Law MIL Performance = 0.1 

Stationary Target Case 2 \ k^ = 0.2 

(a) SUAV & Target Trajectory 


HiL: SUAV & Target Trajectory 
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(b) Range Convergence Performance, P, = 300 


Range Convergence Performance 



Time (sec) 


(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



Figure 38. Constant Gain Control Law MIL Performance = 0.2 
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Stationary Target Case 3: A:; = 0.3 


(a) SUAV & Target Trajectory 


HIL: SUAV & Target Tra]ectot7 



(b) Range Convergence Performance, P, = 300 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



Figure 39. Constant Gain Control Law MIL Performance = 0.3 

Stationary Target Case k^ = 0.4 


(a) SUAV & Target Trajectory 


H iL: SUAV Si Target Trajectory 
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(b) Range Convergence Performance, P, = 300 


Range Convergence Performance 



Time (sec) 


(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



Figure 40. Constant Gain Control Law MIL Performance = 0.4 


78 





























Stationary Target Case 5: = 0.05 


(a) SUAV & Target Trajectory 


HIL: SUAV & Target Trajectory 



(b) Range Convergence Performance, Pd = 300 


Hange uonvergence Keriormance 
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(c) Navigation Error Performance, P, = 300 


Navigation bearing angle convergence performance 
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Non-maneuvering Target Case 1: v, = 5 


(a) SUAV & Target Trajectory 


HIL: SUAV & Target Trajectory 



(b) Range Convergence Performance, Pd = 300 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Gain versus Time 


Gain Versus Time 



Figure 41. MIL Performance for Non-maneuvering Target, v, = 5 
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Non-maneuvering Target Case 2: v, = 10 


(a) SUAV & Target Trajectory 


MIL; SUAV & Target Trajectory 



East (m) 


(b) Range Convergence Performance, P, = 300 


Hange uonvergence Keriormance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Gain versus Time 


Gain Versus Time 



Time (sec) 


Figure 42. MIL Performance for Non-maneuvering Target, v, = 10 
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Non-maneuvering Target Case 3: v, = 15 


(a) SUAV & Target Trajectory 


MIL; SUAV & Target Trajectory 



(b) Range Convergence Performance, Pd = 300 


Range Convergence Performance 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Gain versus Time 


Gain Versus Time 
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Figure 43. MIL Performance for Non-maneuvering Target, = 15 
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Non-maneuvering Target Case 4: v,=20 


(a) SUAV & Target Trajectory 


MIL; SUAV & Target Trajectory 



(b) Range Convergence Performance, Pd = 300 
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(c) Navigation bearing error Convergence Performance 


Navigation bearing angle convergence performance 



(d) Gain versus Time 

uain versus i ime 



Figure 44. MIL Performance for Non-maneuvering Target, v, = 20 
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APPENDIX V. PROCEDURES FOR MIL SIMULATION 


Order 

Procedure 

1 

Set up hardware as described in Chapter III 

2 

Run Piccolo Simulator software on computer #2. Under the ‘file’ tab, 

choose ‘open aircraft’. Select Cub.txt from the folder ‘Cub Model’. Under 

‘file’ tab, choose ‘load state’ option. Select initial state desired. 

3 

On Operator PC, run the Piccolo Operator Software. Using the Futaba 

controller, attempt to achieve trim flight using manual mode. Once trim 

flight is achieved, capture trim flight on the Piccolo Operator software 

and click ‘send’. Switch to autopilot mode on the Futaba controller. 

4 

From the Piccolo Operator Software, design a initial flight plan for the 

SUAV. The Cartesian coordinates of target and SUAV location are given 

in NEU coordinates with respect to the ground station. The inputs to the 

Operator Software have to be given in longitude, latitude and altitude. 

SIMULINK model in Appendix I converts from the desired longitude, 

latitude and altitude to NEU coordinates. 

5 

From the initial location and initial velocity in NEU coordinates, a 3-point 

flight plan can be designed. From the direction of the velocity, choose a 

starting point A in NEU such that vector pointing from A to the initial 

location is in the direction of the velocity. The XPC SIMULINK model 

sets the initial location as the final point of the of the flight plan. When 

editing the flight plan, allow the SUAV to pass through initial location i.e. 

without pre-turn. This can be done by selecting the ‘MAP’ tab on the 

operator software and followed by ‘Edit’ tab. 

6 

XPC SIMULINK model in Appendix I is the MIL simulation interfacing the 

operator PC and SUAV. This model also consist of the algorithm loaded 

onboard SUAV executing the variable gain control law 
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Order 

Procedure 

7 

Start MATLAB 7.1. Load both XPC model and the GUI model in 

MATLAB environment. The GUI model for trajectory display is shown by 

SIMULINK model. 

8 

To run the XPC model, firstly Crtl+D, followed by Ctrl+B. This compiles 

and upload the real-time code onto the PC-104 onboard the SUAV. 

Select “External” and click on “Connect to Target” icon. 

9 

To initiate the MIL simuiation at a desired point of the preset flight pian, 

10 

Click ‘run’ icon on the XPC model followed by ‘run’ icon on the 
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